uint8 INITIALIZING = 1
uint8 WAITING_FOR_ROUTE = 2
uint8 PLANNING = 3
uint8 WAITING_FOR_ENGAGE = 4
uint8 DRIVING = 5
uint8 ARRIVED_GOAL = 6
uint8 FINALIZING = 7
builtin_interfaces/Time stamp
uint8 state
